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ABSTRACT 


The  autonomous  uiubile  robot,  Yainabico-1 1,  recognizes  distance  from  obstacles  by 
a  transmit  and  receive  sonar  pair.  However,  the  current  sonar  amplification  has  not  been 
enough  to  obtain  reliable  range  information.  This  thesis  describes  methods  to  improve  the 
sonar  analog  circuits  on  the  autonomous  mobile  robot  so  that  they  obtain  more  robust  range 
information. 

One  improvement  was  a  change  in  the  driving  voltage  of  the  transmit  transducer  from 
5  volts  to  12  volts  which  doubles  the  strc  •  <  sonar  signal  received  by  the  pickup  sensor. 

After  changing  the  voltage  source,  it  wa^  found  that  there  was  spillover  leakage  directly 
from  the  transmitter  to  the  receiver  transducer.  The  amplifier  sensitivity  was  decreased  for 
the  first  one  millisecond  to  reduce  the  spillover. 
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I.  INTRODUCTION 


A.  BACKGROUND 

Recent  progress  in  robotics  has  been  remarkable.  Efforts  to  increase  robot  intelligence 
have  been  investigated  mainly  from  the  software  side.  On  the  other  hand,  the  hardware 
systems  of  robots  also  have  become  more  capable  due  to  the  advancement  of  electronics 
and  mechanics.  Finally,  sensor  technology  is  progressing  rapidly  allowing  the  sensors  to 
be  more  compact,  sensitive,  and  precise. 

The  autonomous  mobile  robot,  Yamabico-1 1,  at  the  Naval  Postgraduate  School,  is  used 
to  demonstrate  new  technology  in  each  of  the  above  areas.  Particularly  the  sonar  hardware 
system,  which  is  used  to  recognize  a  distance,  has  to  be  improved  because  of  unreliable 
range  information  due  to  noise.  Thus  the  sonar  hardware  system  must  be  replaced  or 
redesigned  to  obtain  more  robust  range  information. 

B.  OVERVIEW 

Currently,  the  Yamabico-1 1  has  a  sonar  system  connected  to  the  VME  system  bus  via 
an  Omnibyte  VME  interface  board.  A  CPU  controls  the  sonar  ranging  system  through  the 
VME  bus  to  read  the  range  data  for  transmittal  the  main  program.  Each  sonar  sensor  is 
controlled  by  a  8748  controller  and  detects  distance  from  an  obstacle.  The  sonar  driver 
board  serves  as  an  interface  between  the  sensor  and  controller/range  counter.  Sonar  data 
detected  by  the  sensor  are  stored  and  sent  to  the  Omnibyte  VME  interface  board. 

The  sonar  analog  system  consists  of  twelve  transmit/receive  sensor  pairs  and  three 
sonar  driver  boards,  it  is  this  portion  of  the  system  that  will  be  improved;  replacing  all 
transducers  and  redesigning  the  sonar  driver  board  to  obtain  more  robust  range  data.  To 
achieve  this  the  driving  voltage  of  the  transmit  transducer  was  increased  from  5  volts  to  1 2 
volts,  which  doubles  the  strength  of  sonar  signal  received  by  the  pickup  sensor. 
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After  changing  the  voltage  source,  it  was  found  that  the  transmit-receive  isolation  was 
not  adequate.  This  leakage  problem  was  eliminated  by  decreasing  the  amplifier  sensitivity 
for  the  first  one  millisecond.  This  method  did  not  affect  valid  sonar  returns. 

Chapter  11  describes  the  sonar  system  used  on  the  Yamabico-1 1  and  the  operation  of 
the  current  circuits.  The  principle  ot  range  finding  is  discussed  briefly.  In  Chapter  111  the 
analog  portion  of  the  sonar  is  described  and  several  methods  of  improving  range 
performance  are  investigated.  The  redesign  of  the  circuits  is  presented  in  Chapter  IV. 
Finally,  Chapter  V  summarizes  the  accomplishments  and  includes  recommendations  for 
future  work. 
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II.  SONAR  SYSTEM  DESCRIPTION 


A.  OVERVIEW 

The  Yamabico’s  sonar  system  includes  a  dedicated  sonar  board  with  a  microprocessor 
which  controls  the  sonar  transducers.  The  robot’s  central  processing  unit  is  interrupted 
only  when  data  becomes  available  from  the  sonar  array.  This  architecture  enables  parallel 
computation  cf  sonar  tasks  with  other  CPU  tasks.  The  sonar  hardware  system  controls  the 
robot’s  array  of  sonar  range  finders.  A  photo  of  the  Yamabico- 1 1  is  given  in  Figure  1 .  The 
transmit/receive  cones  are  visible  at  each  comer  of  the  support  frame.  Figure  2  shows  the 
current  hardv/are  configuration. 


Figure  1:  The  Autonomous  Mobile  Robot  (Yamabico-11) 
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Figure  2:  Sonar  Hardware  Architecture 


B.  PRINCIPLE  OF  RANGE  FINDING 


There  are  four  16  bit  data  registers  on  the  sonar  control  board,  one  for  each  in  a  logical 
group.  When  the  sonar  transmit  pulse  is  sent,  a  pulse  is  sent  to  the  driver/amplifier  boards 
and  a  counter  is  then  started  which  increments  each  of  the  data  registers  every  6 
micro.seconds.  This  round  trip  time  period  is  equivalent  to  a  range 
range  =  (velocity  of  sound)  x  (time)/!  (3.1) 


range  =  (340000  millimeter/second)  x  (6  microsecond)  /!  =  1.02  millimeter 


(3.2) 

The  incrementing  of  a  particular  data  register  continues  until  an  echo  is  received  or  the 
range  gate  times  out.  The  first  12  bits  of  the  data  register  are  allotted  for  range 
accumulation,  thus  allowing  a  maximum  range  of  4.177  meters.  If  the  range  gate  should 
time  out  before  an  echo  is  received,  the  high  bit  of  the  over  ranged  sonar’s  data  register  is 
set  to  1 .  This  is  the  “over  range”  bit  and  is  used  to  signal  the  ensuing  software  that  no  echo 
was  received.  Bits  12,13,  and  1 4  of  the  data  registers  are  not  used.  When  the  ranging  cycle 
is  complete,  the  appropriate  group  number  is  written  into  bits  4  and  5  of  the  status  register 
and  the  “ready”  bit,  bit  7  of  the  status  register,  is  set  to  1 .  The  ready  bit  is  used  as  a  flag 
when  operating  in  the  polled  mode  i.e.  without  interruptions. 

The  maximum  range  measurement  is  4  meters.  The  data  resolution  is  1  millimeter. 
The  sonar  transducers  operate  at  a  frequency  of  40  kHz.  This  is  (1/40  kHz)  =  25 
microseconds  per  cycle.  Assuming  the  speed  of  sound  is  340  meters/second  in  air  at  sea 


level,  the  round-trip  time  is 

400  centimeter  ^  n-  j 

time  -  -  ; - ■,  x2=  23.53  milliseconds 

34000  centimeter/second 


(3.3) 


This  round  trip  time  is  the  period  in  which  a  valid  echo  may  be  received  and  is  referred 
to  as  the  receive  gate.  This  time  interval  is  set  to  to  24  milliseconds,  a  number  derived  by 
division  of  the  .sonar  system’s  2  MHz  clock  pulse  to  ensure  that  the  receiver  is  not  falsely 
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triggered  by  a  direct  path  reception  from  it’s  adjacent  transmitter.  Receivers  are  disabled 
until  the  transmit  pulse  is  completed.  The  disadvantage  of  this  eclipsing  is  a  minimum 
measurable  range  equal  to  half  the  distance  sound  would  travel  in  the  time  of  a  transmit 
pulse. 

The  sampling  rate  can  be  as  high  as  41  Hz  with  only  one  group  enabled  (based  on  a 
24  millisecond  read  gate  as  determined  in  Equation  3.2)  and  will  be  halved  for  each 
additional  group  enabled.  At  a  nominal  robot  speed  of  30  centimeters  per  second,  this 
sampling  rate  provides  an  updated  range  within  0.75  centimeter  of  travel,  exceeding  our 
desired  positional  accuracy  of  1  centimeter.  Of  course,  real  performance  will  be  affected 
by  any  delay  in  reading  the  data  registers  due  to  other  demands  on  the  central  processor 
(processing  the  sonar  data,  controlling  motion,  etc.). 

The  minimum  range  of  detection  is 

range  =  (34000  centimeter/ second)  x  (1  millisecond)  /2  =  17  centimeters 

(3.4) 

This  minimum  range  lies  approximately  9  centimeters  outside  the  periphery  of  the  robot. 
In  order  to  allow  the  measurement  of  objects  up  to  the  periphery  of  the  robot,  the  pulse 
width  was  decreased  to  0.5  milliseconds  which  reduced  the  minimum  range  to  X.5 
centimeters. 

In  practice,  the  minimum  range  is  set  to  9.6  centimeters  because  of  the  firmware;  the 
additional  distance  is  due  to  the  time  needed  for  switching  and  settling  in  the  circuitry. 
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C.  SONAR  GROUPING 


In  order  to  reduce  sampling  time,  the  sonars  are  operated  in  logical  groups  of  four.  All 
sonars  of  a  logical  group  are  pulsed  simultaneously.  The  group  to  be  fired  is  determined 
by  the  value  of  the  corresponding  bit  in  the  command  resister  of  the  sonar  control  board, 
which  is  the  user  set  with  an  Model-Based  Mobile  Robot  Language  (MML)  function 
(Figure  2).  Hence,  if  bit  2  is  set  to  1 ,  group  2  sonars  will  be  pulsed.  When  more  than  one 
group  is  selected,  the  sonar  control  board  will  trigger  one  group  at  one  time  in  a  sequential 
fashion.  The  sensors  of  a  logical  group  are  pulsed  simultaneously  and  thus  the  sampling 
time  is  reduced  by  a  factor  of  four  as  compared  to  firing  the  sensors  individually.  The 
sonars  of  each  logical  group  are  oriented  in  such  a  way  as  to 

1 .  prevent  mutual  interface 

2.  provide  a  “look”  in  all  four  directions,  and 

3.  present  a  similar  aspect  from  each  .sonar  during  a  rotational  scan. 

Logical  group  0  consists  of  sonars  0,  2,  5,  and  7;  group  1  consists  of  sonars  1 .  3,  4,  and  6; 
group  2  consists  of  sonars  8,  9,  and  1 1 ;  and  group  3  is  a  “virtual”  group  which  consists  of 
four  permanent  test  values.  The  sonars  of  a  group  are  symmetric  about  the  robot’s  axis  of 
rotation.  Figure  3  shows  the  Yamabico  sonar  placement. 

In  addition  to  being  grouped  logically,  the  sonars  are  also  grouped  physically. 
The  sonars  are  physically  grouped  so  as  to  distribute  the  electrical  load  over  the  driver 
boards  evenly  and  to  minimize  any  electrical  transients  associated  with  operation  of  the 
sonar.  The  physical  grouping  connects  sonars  0,  2,  8.  and  1 1  to  drive/amplifier  board  1 ; 
sonars  4,  5, 6,  and  7  to  board  2;  and  sonars  1,  3, 9,  and  10  to  board  3.  The  reader  will  note 
that  pairs  of  sonars  from  logical  groups  are  assigned  to  physical  groups. 


Figure  3:  Yamabico  Sonar  Placement 
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D.  OPERATION  BY  LOCAL  CONTROLLER 

The  sonar  control  board  is  actually  a  daughtercard  which  rides  on  a  VME  bus 
mothercard.  The  mothercard  carries  address  decoders,  bus  drivers  and  interrupt  control 
circuitry  in  the  Bus  Interface  Module  (BIM). 

When  the  sonar  has  completed  a  ranging  cycle  an  interrupt  request  is  provided  to  the 
BIM.  The  BIM’s  control  register  holds  information  which  determines  whether  an  interrupt 
is  to  be  generated  or  not,  and  if  so,  which  interrupt  level  is  to  be  generated.  Presuming  an 
interrupt  is  generated,  when  the  correct  acknowledgment  returns  on  the  address  lines  the 
BIM’s  vector  register  provides  the  vector  table  entry  to  the  central  processor  and  finds  the 
vector  to  the  interrupt  handler.  The  correct  interrupt  level,  the  interrupt  enable  bit  and 
interrupt  vector  are  loaded  to  the  BIM  during  software  initialization. 

Each  of  the  data  resisters  is  individually  addressed  on  the  VME  bus  by  a  VME  short 
address,  as  is  the  status  register.  Transfer  of  the  data  is  straightforward.  The  interrupt 
handler  simply  reads  the  correct  register,  masks  out  the  unwanted  bits  and  writes  the  data 
to  the  stack.  When  the  last  data  resister  is  read,  the  sonar  system  resets  the  data  registers 
and  commences  a  ranging  cycle  on  the  next  sonar  group  in  its  sequence.  The  system  will 
continue  to  operate  autonomously  until  all  the  sonars  are  disabled. 


III.  SONAR  ANALOG  SYSTEM  IMPROVEMENT 


A.  CHANGING  OF  SUPPLY  VOLTAGE 

Each  sonar  consists  of  a  transnut  and  receive  transducer  pair  (Figure  4)  which  are 
connected  to  a  sonar  driver  board.  Each  sonar  driver  board  in  turn  handles  four  transducer 
pairs.  The  board  provides  a  TTL  level  interface  to  each  transducer.  The  transmit  signal  to 
the  sonar  driver  board  is  a  TTL  high  when  the  transmitter  is  inactive.  A  4()  kHz  active  low 
square  wave  must  be  provided  to  generate  the  transmit  ping.  There  is  a  separate  drive  line 
for  each  of  the  four  sonar  transmitters.  The  transmit  transducers  are  driven  by  an  SGS  L293 
integrated  circuit.  This  chip  contains  four  separate  buffer  drivers.  Each  buffer  driven  by 
TTL  level  signals  from  separate  74LS240  inverters  drives  one  sonar  transducer. 

The  drive  level  to  the  transmit  transducers  was  originally  a  +5  volt  square  wave.  In 
order  to  increase  the  output  voltage  of  transmit  transducer,  the  equivalent  of  a  40  kHz,  +  10 
volt  square  wave  circuit  was  achieved  by  using  a  2  MHz  clock  pulse  and  TTL  chips.  Figure 
5  shows  an  experimental  circuit  for  transmitters. 
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IVansducff 


Figure  4:  Sonar  Sensor  Pair 
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B.  SPILLOVER  REDUCTION 

The  current  receiver  amplifier  is  a  TLC272ACP  dual  integrated  operational  amplifier. 
The  amplifiers  in  this  chip  are  designed  to  operate  from  a  single  supply  voltage  of  +5  volts. 
The  two  stages  are  connected  to  form  a  DC  amplifier  with  a  gain  of  3300.  The  amplifier 
output  runs  to  a  74LS14  schmitt  trigger,  and  then  to  an  output  driver. 

Driving  the  transmit  transducer  with  +  10  volts  causes  a  serious  transmit  spillover 
problem:  direct  signals  from  the  transmitter  to  the  receiver  mask  valid  returns.  To  suppress 
the  transmit  spillover  while  still  allowing  for  valid  sonar  returns,  it  is  necessary  to  modify 
the  receive  amplifiers.  Circuitry  is  added  that  decreases  sensitivity  for  the  first  millisecond 
after  the  end  of  the  transfnit  pulse.  Figure  6  shows  the  spillover  reduction  circuit  based  on 
the  original  circuit  with  adding  of  a  capacitance-resistance  circuitry  and  supply  voltage  of 
-  5  volts  and  - 1 2  volts. 
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IV.  EXPERIMENTAL  RESULTS 


This  chapter  presents  measured  data  from  the  redesigned  transmit  and  receive  circuits. 

A.  TRANSMITTER 

As  shown  in  Figure  7,  the  transmit  transducer  output  voltage  increases  from  about  +  4 
volts  to  10  volts  for  the  circuit  in  Figure  5  with  both  h'equencies  at  40  kHz  (cycle  is  25 
microsecond). 


^  ~  ^ 


(a)  Supply  voltage  s  5  volts  (x:  1  msecJdiv  y:  20  mV./div) 


(b)  Supply  voltage  =  +12  volts  (x:  1  insec./div  y:  50  mVJdiv) 
Figure  7:  Transmit  Transducer  Output  Voltage 


B.  RECEIVER 


1.  Effect  of  Change  in  Transducer  Output 

When  transmit  transducer  output  voltage  is  changed  from  4  volts  to  10  volts,  the 
receive  transducer  output  voltage  is  increased  as  shown  Figure  8. 


(a)  Supply  voltage  =  +  5  volts  (x:  1  nisec./div  y:  20  mV./div) 


(b)  Supply  voltage  =  -1-12  volts  (x:  1  msec/div  y:  50  niV./div) 
Figure  8:  Receive  Transducer  Output  Voltage 
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2.  Effect  of  Spillover 


After  increasing  the  transmit  transducer  output  voltage  to  10  volts,  the  value  of 
spillover  increased.  Figures  9  and  10  show  a  sonar  driver  board  circuit  and  output  voltage 
at  points  G  and  H  on  the  circuit  without  spillover  countermeasure  circuit.  The  presence  of 
this  spillover  prevents  a  correct  range  reading  for  the  wall. 


Figure  9:  Sonar  Driver  Board  (Spillover) 


17 


The  photos  show  that  the  spillover  output  from  0.5  milliseconds  to  3.0  milliseconds 
after  transmit  transducer  output  pulse  disappears.  Consequently,  the  correct  range  from  the 
wall  is  obtained. 


(a)  Point  G  (x:  1  msecidiv  y;  1  V./div) 


(b)  Point  H  (x;  1  msec./div  y:  2  V^^div) 

Figure  12:  Output  Voltage  (Spillover  Countermeasure) 
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3.  Frequency  Response 

Figure  13  shows  the  test  circuit  for  the  frequency  response.  The  output  was 
measured  while  sweeping  the  input  frequency  from  8  Hz  to  120,800  Hz,  with  the  supply 
voltage  of  the  sine  wave  constant  with  200  millivolts  peak-to-peak. 


SineWaveGemrttoor 


Figure  13:  Test  Circuit  of  Frequency  Response 


Vout  p-p  (m 


This  measurement  provides  an  indication  of  the  noise  immunity  of  this  circuit. 
The  result  is  shown  in  Figure  14.  According  to  this  result,  a  frequency  of  4U  kHz.  which 
transmit/receive  transducer  uses,  is  close  to  the  maximum  frequency  response. 


Frequency  (Hz) 


Figure  14:  Frequency  Response 
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4.  Gain  Measurement 

The  gain  of  the  modified  circuit  was  measured  by  using  the  test  circuit  shown  as 
Figure  16,  where  the  frequency  of  the  square  wave  was  40  kHz.  From  the  measurement, 
the  1st  stage  gain  of  operational  amplifier  and  2nd  stage  gain  are  as  follows; 

1  st  stage  gain  =  201og( V 1  A^in)  =  201og(20/0.2)  =  40  dB  (5.1) 

2nd  stage  gain  =  201og(V2A^  1 )  =  201og(88/20)  =  1 2.87  dB.  (5.2) 


Function  G  enerator 


Figure  16:  Test  Circuit  fur  (iain  Measurement 
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5.  Amplifier  Sensitivity 

The  input  voltage  required  for  detection  versus  time  from  transmit  pulse  was 
measured  in  order  to  get  the  shape  of  the  threshold  envelop.  Figure  1 6  shows  the  test  circuit 
for  this  measurement.  The  result  is  shown  in  Figure  17.  It  shows  a  monotonic  decrease  in 
voltage  with  time  after  the  transmit  pulse  is  initiated,  and  becomes  constant  after  about  6 
milliseconds. 


Function  G  enerator 

(401tHz  square  wave)  Oscilloscope 
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6.  Sensitivity  Dependency  on  Distance 


The  sensitivity  of  the  range  measurement  depends  on  the  gain  of  the  modified 
circuit.  Figure  18  shows  the  gain  measurement  configuration.  The  gain  as  a  function  of 
distance  is  shown  in  Figure  19  for  the  new  circuit. 


Figure  18:  Test  Method  for  Gain 


Figure  19:  Output  Vultugeuf  Receive  Transducer  (1) 
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In  Figure  20,  gain  data  for  the  old  circuit  with  5  and  i  2  volt  sources  arc  shown 
along  with  the  data  for  the  new  circuit.  Both  of  the  12  volt  cases  have  comparable 
performance,  except  at  ranges  less  than  approximately  25  centimeters. 


Figure  20:  Output  Voltage  of  Receive  Transducer  (II) 


2X 


7.  Minimum  Range 


With  the  test  coirHgtiration  shown  in  Figure  18,  the  minimum  range  was  found. 
Figure  21  shows  the  output  voltage  of  receive  transducer  and  the  output  voltage  from 
Schmitt  T-igger  (74LS14)  chip. 


(a)  Receiver  Transducer  (x:  1  msec./div  y:  50  mV./div) 


(b)  Schmitt  Trigger  (x:  1  msec./div  y:  2  V./div) 
Figure  21:  Output  Voltage  for  Minimum  Range 
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According  to  this  result,  the  minimum  range  lies  approximately  2.0  centimeters 
outside  the  periphery  of  the  robot 

range  =  (34000  centimeter/ second)  x  (0.6  millisecond)  /2  =  10  centimeters 

(5.3) 

Therefore,  by  using  the  modifled  circuit,  an  improvement  in  the  minimum  range  was 
achieved;  from  17  centimeters  to  10  centimeters. 
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8.  Noise  Measurement 


The  receive  transducer  signal  was  measured  while  the  robot  was  in  operation 
(Appendix).  There  was  significant  noise  at  a  frequency  of  7.9  kHz  (magnitude  of  20 
millivolts)  caused  by  the  driving  motor  with  pulse  width  modulation.  Figure  22  shows  the 
output  voltage  of  the  receive  transducer. 


Figure  22:  Noise  at  Receive  Transducer 
(x:  1  nisec./div  y:  20  mV./div) 
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Figure  23  shows  ouq)ut  voltage  of  the  pre-stage  on  Schmitt  Trigger  Inverter. 
This  shows  a  period  is  126.6  microseconds  (1/7900  =  126.6)  and  a  ntagnitude  of  0. 14  volts. 
Therefore,  the  noise  is  small  enough  so  that  a  Schmitt  Trigger  Inverter  can  be  used 
(minimum  trigger  voltage  =  1.4  volts). 


Figure  23:  Noise  at  Pre-Stage  of  Schmitt  Trigger  Inverter  (1) 
(x:50  usecJdiv  y:  0.1  V7div.) 
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Figure  24  shows  ouqiut  voltage  of  pre-stage  on  Schmitt  Trigger  Inverter  after  the 
circuit  was  installed  permanently  on  the  driver  board.  This  result  indicates  a  noise  level  of 
0.28  volts.  Therefore,  the  modified  receiver  amplifier  circuit  was  not  affected  by  motor 
noise. 


Figure  24:  Noise  at  Pre-Stage  of  Schmitt  Trigger  Inverter  (II) 
(x:50  usec^div  y:  O.I  V./div.) 


V.  CONCLUSIONS 


A.  RESULTS 

The  performance  of  the  sonar  hardware  system  on  the  autonomous  mobile  robot 
Yamabico-1 1  was  improved.  By  changing  the  driving  voltage  of  the  transmit  uansducer 
from  5  volts  to  12  volts,  the  receive  gain  was  increased  threefold.  TTie  sonar  system  is  now 
capable  of  reliably  detecting  an  obstacle  at  a  distance  of  four  meters.  A  disadv.-mtage  of 
increasing  the  voltage  was  an  increase  in  spillover  directly  from  the  transmitter.  The 
spillover  interference  was  cut  by  the  addition  of  capacitance-resistance  circuits  and 
negative  voltage  source  for  suppressing  the  gain.  Also,  the  modified  circuit  had  the  added 
advantage  of  shortening  the  minimum  range  to  10  centimeters.  The  new  design  was 
fabricated  and  installed  permanently.  Tests  on  the  installed  circuit  showed  that  it  was  not 
affected  by  noise. 

B.  RECOMENDATIONS 

The  remaining  sonar  driver  circuits  should  be  upgraded,  and  testing  should  be  done  to 
ensure  that  the  sonar  parameters  arc  optimized.  Finally,  the  effectiveness  of  the  sonar  in 
obstacle  avoidance  must  be  studied. 
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APPENDIX 


This  {^pendix  contains  the  C  code  for  sonar  testing  and  the  user  file  that  were  used  in 
this  thesis. 

APPENDIX  A  SONAR  TEST  CODE 


#  sonartestS.s 

# 

#  This  program  adds  the  "H",  “V",  and  "G"  commands  to  the 
sonar  test  program. 

# 

#  Typing  an  "H"  puts  the  program  in  HUSH  mode.  The  program 
continually  ranges 

#  without  calculating  any  values  or  printing  anything  to 
the  screen.  This 

#  allows  generating  totally  evenly  spaced  pings .  Typing 
■V"  restores  the 

#  program  to  VERBOSE  mode,  where  it  calculates  the  average, 
quality,  and 

#  hits,  and  prints  them  to  the  screen. 

# 

#  Typing  a  "G"  results  in  the  program  printing  a  "GAP=?“  to 
the  screen. 

#  A  DECIMAL  value  terminated  by  a  <CR>  may  be  typed.  This 
value  will  be 

#  the  delay  between  the  end  of  the  last  range  cycle  and  the 
beginning  of  the 

#  next  range  cycle.  Values  are  in  milliseconds.  Typing 
"0"  or  just  a  <CR> 

#  sets  this  delay  to  zero.  This  delay  applies  when  the 
program  is  in  HUSH 

#  or  verbose  mode. 

# 

#  System  range  test  program. 

#  Any  ONE  sonar  may  be  selected  by  typing  its  number.  Use 
"A"  for  sonar 

#  10  and  -B"  for  sonar  11.  Use  "C“,  "D",  "E",  and  "F"  for 
the  four  test 
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#  values.  IVpe  “Q"  to  exit  the  program. 

# 

#  The  constant  "samples*  is  the  number  of  range 
measurements  that  will 

#  be  taken  and  averaged  for  the  final  range 
determination.  This  average 

#  value,  or  nominal  range  will  be  printed  to  the  control 
terminal . 

# 

#  Each  of  the  range  values  that  is  not  an  over range  will  be 
added  to  the 

#  others,  then  divided  by  the  number  of  non-overrange 
values.  This  is  the 

#  nominal  value.  Then  the  number  of  range  values  that  are 
within  plus  or  minus 

#  "qwidth*  millimeters  of  the  nominal  value  are 
determined.  The  percentage  of 

#  values  within  #  this  spread  is  the  quality.  Finally,  the 
percent  of 

#  non-overrange  values  to  overrange  values  is  the  hit  rate. 

# 

# 

#  Assemble  and  link  the  program  with  the  following  two 
command  lines: 

# 

#  as  -o  sonartest2.o  sonartest2.s 

#  Id  -s  -T  304000  -e  beg  -o  sonartest2 .out  sonartest2.o 

# 

#  Then  log  into  the  yamabico  account  at  the  robot -terminal 
shared  line. 

#  Type  "cs"  (this  sets  up  aliases  and  cd's  to  the  "mml" 
subdirectory) .  Copy 

#  the  '‘sonartest2  .out "  program  into  the  "mml" 
subdirectory.  Turn  on  the  robot, 

#  and  switch  the  serial  line  from  the  terminal  to  the 
robot.  At  the  robot 

#  console  type: 

#  lo  =  dload  sonartest2 .out 

# 

#  Ignore  the  checksum  error  messages  and  type*. 

# 

#  g  304000 

# 


36 


#  to  start  the  program. 


#  Samples  is  the  number  of  sonar  samples  in  each  test  cycle, 

samples  =  32 

#  Qwidth  is  the  number  of  millimeters  plus  or  minus  the 
nominal  value  that 

#  a  data  value  can  be  and  be  counted  as  a  quality  value. 


qwidth 
is  1  cm 

5 

#  Ascii  codes 

aspace  = 

0x20 

azero  = 

0x30 

anine 
“ 9 "  code 

s 

0x39 

quest 
“ ? "  code 

s 

0x3  f 

ana 

“A"  code 

s 

0x41 

anf 

"F"  code 

= 

0x46 

agee 
"G"  code 

sz 

0x47 

anh 

■H"  code 

zz 

0x48 

aque 
■Q"  code 

= 

0x51 

avee 

"V"  code 

0x56 

#  1  ms  timing  loop  count  value, 
modified. 

tlcnt  =  0x9 

loops  for  1  ms  delay 


I  +-5  mrii 

1  ascii  space  code 
ascii  "0"  code 

I  ascii 
I  ascii 
I  ascii 
t  ascii 
I  ascii 
I  ascii 
I  ascii 
I  ascii 

Adjust  if  timing  loop 

I  timing 


#  Sonar  board  status  register.  Bit  7  (0x80  hex)  indicates 
busy.  Bits  4  and 
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#  3  encode  the  current  sensor  group 

statreg  =  0xffff83f9 

status  register  address 
bsyb  =  0x80 

sgmask  =  0x18 

#  Sonar  board  data  registers 

sOdata  =  0xffff83f0 

registers 

sldata  =  0xffff83f2 

s2data  &  0xf£f£83£4 

s3data  =  0xffff83f6 

register  address 

#  Sonar  board  overrange  indicator  value 

overrng  =  0x8000 

overrange  value 


. globl  beg 
first  instruction 
.  text 

#  Write  out  an  introduction  line 

beg:  movl  istmesg,  aO 

of  message 

movl  #stmese,  al 
of  message  +  1 

jsr  prline 

#  Initialize  variables 

movl  #0,  dO 

movl  dO ,  hushf 

flag 

movl  do,  gapsiz 

#  Initialize  next  sample  cycle 


I  sonar  board 

I  busy  bit 
I  sonar  group  mask 

I  sonar  board  data 

I  sensor  #3  data 


I  let  loader  access 

I  get  start  address 
1  get  end  address 
I  print  to  console 

I  get  0 
I  clear  hush  mode 

I  set  gap  to  0 
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wl2:  movl  #san?)les,  pingcti  initialize  ping 

co\inter 


movl 

#sdata,  saddr 

1  initialize 

storage  counter 

#  Wait  for  next 

sonar  data  or  key  press 

wll:  movl 

gapsiz,  dO 

1  get  gap  value 

movl 

dO ,  gapval 

1  reset  delay 

'inter 

trap 

#15 

1  get  tty  input 

_catus 

.word 

0x0001 

1  .instat  function 

jeg 

sdl 

1  no  key  pressed. 

continue 

#  Key  pressed 

wl6:  sxibgl 

#2 ,  sp 

1  make  space  on 

stack  for  character 

trap 

#15 

1  get  character 

from  input 

.word 

0x0000 

1  .inchr  function 

movb 

sp@+,  do 

1  put  char  in  dO, 

fix  stack 

andl 

#0x7 f,  dO 

1  mask  any  parity 

bit 

jsrselson 

1  select  sonar  from 

pressed  key 

jmp 

wl2 

1  restart 

data  collection 

#  Check  if  a  sonar  group  is  ready 

sdl :  movb 

statreg:!,  dl 

1  get  sonar  status 

andb 

#bsyb,  dl 

1  see  if  busy  flag 

set 

jne 

wll 

1  if  still  busy  loop 

#  Gap  after  sonar  coirqpletes 

wl5 :  movl 

gapval ,  dO 

1  get  delay  count 

anal 

#0xffffffff,  dO  1  check  for  zero 
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beq  wl4  I  if 

delay  expired  continue 

subl  #1,  dO  I 

decrement  delay  count 

movl  dO,  gapval  1  store  new  gap 

I  get  tty  input 

I  .instat  function 
I  no  key  pressed, 

I  key 


#  Check  for  HUSH  mode  after  sonar  conpletes 


wl4 : 

movb 

Wshf ,  dl 

1  get  hush 

mode  flag 

andb 

#0xff,  dl 

1  check  if 

hush 

flag  set 

jeq 

wl3 

1  not 

hush  mode,  process  data 

#  Hush  mode,  restart  sonar  and  continue  looping 

movw  s3data;l,  dO  I  restart  sonar 

jmp  wll  1 

continue  looping 


#  Verbose  mode,  store  data  and  decrement  ping  count 


wl3 : 

movl 

saddr,  aO 

1  get  data  table 

pointer 

movl 

sdreg,  al 

1  get  sonar 

register 

address 

movw 

al@,  dO 

1  get 

sonar  data 

movw 

dO,  a0@+ 

1  store  in  data 

array 

movw 

movl 

s3data:l,  dO 
aO ,  saddr 

1  restart  sonar 

1  update  data 

pointer 

subl 

#1,  pingct 

1  decrement  ping 

count 

value 

trap  #15 

status 

.word  0x0001 
jeq  wl5 

continue 

jnqp  wl6 

pressed,  so  handle 
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jne  wll 

#  Compute  results 


3sr 

citpav 

1  conpute 

average  range. 

and  hits 

jsr 

cmpqu 

1  coirpute 

Q  value 

jsr 

cnvqh 

1  make  Q 

and  hits  percent  values 

jsr 

prdata 

1  print 

data  to  console 

jmp 

wl2 

1  begin 

next  cycle 

#  Return  to  on 

board  debug  monitor 

leave ;  movb 

#0,  dO 

1  turn  off  sonars 

movb 

dO,  statreg:! 

movw 

s3data:l,  dO 

1  flush  any  old  data 

trap 

#15 

1  return  to  debug 

.word 

0x0063 

1  .return  function 

#  Select  Sonar.  Call  with  key  press  data  in  dO .  This 
routine  looks  up 

#  the  corresponding  sonar  and  sets  the  sonar  number  in  the 
data  message, 

#  sets  the  correct  sonar  data  address  in  "sdreg",  and 
writes  the  correct 

#  group  select  to  the  sonar  command  register. 


selson:  cnpb 

nxjmber  ? 

tquest,  dO 

1  is 

it 

letter  or 

bgt 

selnol 

1  go 

handle  letter 

cirpb 

#azero,  dO 

1  is 

it 

less  than 

"0" 

bit 

selex 

1  if  so 

bad  input  so  exit 

cmpb 

#anine,  dO 

1  is 

it 

greater 
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selex 


I  if  so 


bgt 

bad  input  so  exit 

subb  iazero,  dO  I  normalize  ascii 

to  digit 


jmp 

load  values  from 

seltbl 

table 

1  and 

selnol :  andb 

upper  case 

#0x5f,  dO 

1  make  lower  case 

cmpb 

#aque,  dO 

1  is  input  a  *Q" 

beq 

exit 

leave 

1  if  so 

cnpb 

#anh,  dO 

1  is  input  "H* 

bne 

next  if  not 

selno2 

1  skip 

movb 

#0xff,  hushf 

1  set  hush  flag  on 

movl 

start 

#husmsg,  aO 

1  get  hush  messages 

movl 

end 

#husmse,  al 

1  get  hush  message 

jsr 

hush  message 
rts 

prline 

1  print 

selno2 :  cirpb 

#avee,  dO 

1  is  input  "V" 

bne 

next  if  not 

selno3 

1  skip 

movb 

rts 

0x0 ,  hushf 

1  set  hush  flag  off 

selno3 :  cmpb 

#agee,  dO 

!  is  input  "G" 

beq 

set  gap  routine 

setgap 

1  go  to 

cupb 

"A" 

#ana,  dO 

I  is  it  less  than 

bit 

bad  input  so  exit 

selex 

1  if  so 

cnpb 

than  "F" 

#anf,  dO 

1  is  it  greater 

bgt 

bad  input  so  exit 

selex 

1  if  so 

subb 

#0x37,  dO 

1  normalize  ascii 
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to  digit 

seltbl :  roll 

#3,  dO 

1 

multiply  digit  by 

8  for  offset 

movl 

#sptabl,  aO 

1  get  table  start 

address 

addl 

do,  aO 

1  form 

data  table  entry  address 

movl  a0@+,  sdreg  I  load  data 

register  pointer 

movw  a0@+,  dtamsg  I  load  sensor 

niiinber  in  data  string 

nvovb  a0@,  statreg:!  I  load  group  to 

sonar  command  register 
selex;  rts 


#  Setgap  routine.  Print  the  message  "DELAY=?  then  read 
a  DECIMAL  value 

#  up  to  9999,  The  decimal  value  is  delay  in  milliseconds 
between  the  end 

#  of  one  ranging  cycle  and  the  beginning  of  the  next .  Set 
the  Delay  value. 


setgap :  movl 

tgapmsg. 

aO 

1  get  start  of 

message 

movl 

#gapinse. 

al 

1  get  message  end 

jsr 

prstng 

1  print 

message 

jsr 

delay  value  into 

rdline 

buffer 

1  read 

jsr 

cnvtsn 

i  convert 

to  value  in  dO 

bne  set err 

zero  return  error 

1  if  not 

mulu 

loop  count  by  ms 

#tlcnt , 
needed 

dO 

1  multiply  1  ms 

movl 

do,  gapsiz 

1  initialize  gap 

coxint 

rts 

set err:  movl 

#derrms. 

aO 

1  get  error  message 

movl 

#derrme. 

al 

1  get  message  end 

jsr 

prline 

1  print 
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setgap 


I  and  try 


error  message 
jrt^ 

again 


#  Convert  text  string  to  number.  Call  with  the  address  of 
the  text  string 

#  count  byte  the  aO  register.  Return  with  the  converted 
value  in  the  dO 

#  register.  If  the  number  of  characters  is  zero  return  with 

#  a  value  of  0.  If  the  string  converts  correctly  return 
with  zero  flag  set, 

#  otherwise  return  with  zero  flag  clear. 


cnvtsn:  movl#0,  dO  I  setup  dO  as  total 

accumulator 


movb 

into  dl 

a0@+,  dl 

1  get 

count  byte 

cmpb 

greater  than  4? 

#4,  dl 

1  is  it 

bgt 

error 

cnvts3 

1  if  so 

cnvtsl :  andb 

#0xff,  dl 

1  is 

dl  zero 

bne 

zero,  continue 
cnvts3 :  rts 

done 

cnvts2 

1  not 

1  else 

cnvts2 :  movb 

jsr 

a0@+,  d2 
cnvdig 

1  get 

character 

bit 

minus ,  error 

cnvts3 

1  if 

mulu 

multiply  previous 

#10,  dO 
total  by  10 

1 

addw 

new  data 

d2,  dO 

1  add  in 

subb 

#1,  dl 

1  reduce 

char  count 

jmp  cnvtsl  I  continue 

#  Convert  digit.  Call  with  the  ascii  code  for  a  decimal 
number  between 

#  0  and  9  in  the  6.2  register.  Return  with  the  value  in  the 
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d2  register. 

#  If  the  ascii  code  is  outside  the  correct  range  return 
with  minus  flag 

#  set . 


cnvdig:  andl  #0x7f,  d2  1  mask  unneeded  bits 

subb  #azero,  d2  I  normalize  ascii 

to  number 

bit  cnvdil  i  if 

ascii  below  zero  code  error 

movb  #9,  d3  I  check 

for  above  range 

cnpb  d2 ,  d3 

cnvdil:  rts 


#  Conpute  Average  Value.  This  routine  computes  the  average 
value  of  the 

#  data  in  the  "sdata"  array.  This  average  value  is  placed 
in  "nomval" . 

#  Note  that  ONLY  non-overrange  values  are  computed.  The 
number  of 

#  non-overrange  values  in  the  table  is  saved  in  "hitval". 

If  ALL  values 

#  are  overrange  "nomval"  is  set  to  0x8000  and  “hitval" 
equals  0 . 


cnpav :  movl 

to  values 

movl 

initialize  dO  to 
movl 

initialize  dl  to 
movl 

test  counter 
cmpll :  movw 

cmpw 
beq 

overrange  do  not 
addl 

dO  total 


#sdata,  aO 
#0,  dO 

accumulate  sum 
dO,  dl 

accumulate  hits 
#sairples,  d2 

a0@+,  d3 
#overrng,  d3 
cmpl2 

add  or  incr  hits 
d3,  dO 


addl  #1,  dl 

increment  hit  counter 
ciipl2 :  subl  #1,  d2 


use  aO  to  point 


initialize  d2  as 

get  value  into  d3 
test  for  overrange 
I  if 

I  add  to 
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decrement  loop  count 


bne 

cmpll : 

movl 

dl,  hitval 

1  set  hitval 

citqpl 

#0,  dl 

1  check 

for  no  hits 

bne 

cnpl3 

1  if  hits 

go  and  handle 

movl 

ioverrng,  nomval 1  indicate  all  overrange 

rts 

1  finished 

cnqpl3 :  divu 

average  range 

dl,  do 

1  coitpute 

andl 

iOxffff,  dO 

1  discard  remainder 

movl 

dO ,  nomval 

i  store  in  nomval 

rts 

1  finished 

#  Confute  quality, 
routine  has  set 

Call  AFTER  “confute 

average  value* 

#  "nomval"  and  "hitval".  This  routine 

scans  the  data  in 

the  “sdata"  array. 

#  Every  value  within  pi’  or  minus  “qwidth"  millimeters  of 

the  average 
#  value  is  counted 

as  a  quality  value. 

citpqu :  movl 

to  values 

#sdata,  aO 

1  use  aO  to  point 

movl 

nomval ,  dl 

1  get  average  value 

movl 

#qwidth,  d2 

1  get  qwidth 

addl 

dl,  d2 

1 

calculate  high  value  in  d2 

subl 

#qwidth,  dl 

1  calculate  low 

value  in  dl 

movl 

#samples,  d4 

1  put  loop  count  in 

d4 

movl 

#0,  d3 

1  set  d3 

as  compare  counter 

cmpgll:  movw 

a0@+,  do 

1  get  value 

cmpl 

d2,  dO 

1  is 

value  >  max  hi 

bgt 

cmpql2 

1  if 
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value  >  max  hi 

do 

not  incr 

Q 

cnqpl 

dl,  dO 

1  is 

value  <  min  lo 

bit 

cnpql2 

1  if 

value  <  min  lo 

do 

not  incr 

Q 

addl 

#1,  d3 

1  quality 

value,  incr  Q 

citpql2 :  subl 

#1,  d4 

1  deer 

loop  count 

bne 

citpqll 

1  test 

remaining  values 

nuovl 

d3 ,  qval 

1  set  qval  value 

rts 


#  Convert  Q  and  hits  to  percent.  This  routine  converts  the 
Q  value  to  a 

#  percent  of  the  total  hits,  and  the  hits  value  to  a 
percent  of  the  total 

#  saitples.  The  values  are  then  written  back  to  the  “qval“ 
and  "hitval" 

#  locations. 

cnvqh;  movl  #<3val,  aO 

movl  hitval ,  dl 

jsr  ctpcnt 

qval  percent  of  hits 

movl  #hitval,  aO  I  get  hitval  address 

movl  #saitples,  dl  I  get  saitples 

j  sr  ctpcnt  I  make 

hitval  percent  of  sair^jles 
rts 

#  Convert  to  Percent.  This  routine  converts  the  ratio  of 
two  quantities 

#  to  a  percent  value  between  0  to  100.  Call  with  the  "aO" 
register 

#  pointing  to  the  numerator,  and  with  dl  containing  the 
denominator . 

#  The  percent  of  the  two  values  will  be  written  to  the 
location  pointed 

#  to  by  "aO" . 


I  get  qval  address 
I  get  hitval 

I  make 
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#0,  dl 


I  check 


ctpcnt :  cinpl 

for  zero  denominator 


bne 

zero  continue 

ctpctl 

1  if  not 

movl 

percent  to  zero 
rts 

#0,  a0@ 

1  set 

ctpctl:  movl 

value  to  convert 

aOQ,  dO 

1  get 

mulu 

#100,  dO 

1  multiply  by  100 

divu 

by  denominator 

dl,  dO 

1  divide 

andl 

#0xffff,  dO 

1  mask  remainder 

movl 

converted  value 
rts 

dO,  a0@ 

1  store 

#  Convert  Hex  *-o 

decimal  ascii. 

Call  with  a  hex  value  less 

than  or  equal  to 

#  8191  decimal  in  the  dO  register.  The  aO  register  is  a 
pointer  to  the 

#  memory  location  where  the  ascii  equivalent  will  be 
stored.  Leading  zeros 

#  will  be  suppressed  and  replaced  by  spaces.  If  the  input 
value  is  >  8191 

#  the  word  "  OVER"  will  be  printed  instead  of  a  number. 


hexasc 
for  > 

:  movl 
8191 

dO,  d3 

1  test  input  value 

valid 

andl 

#0xffffe000,  d3 

1  and  zero  d3  if 

print 

jne 

•  OVER" 

ovrmg 

1  go  to  routine  to 

#  d3  is  the  leading  zero  suppress  flag.  If  it  is  zero  then 
we  are  still 

#  suppressing  zeros.  It  will  be  set  to  OxFF  when  a  non¬ 
zero  data  value  is 

#  encoxontered. 


movl 


#3,  d2 


I  use  d2  for  the 


divide  loop  count 

movl  tdivsr,  al 
to  divisors 


use  al  to  point 


#  The  divide  loop  divides  dO  by  1000,  then  100,  then  10. 
Each  time  the 

#  quotient  is  converted  to  ascii  and  written  to  the  line 
assembly  area, 

#  and  the  remainder  is  placed  in  dO  to  be  divided  in  the 
next  loop. 


dvloop :  movl 
dl,  inc  al 

al@+,  dl 

1 

put  divisor  in  to 

divu 

dl,  dO 

1 

divide  by  power 

of  10 

movw 

dO,  dl 

1 

move  quotient  to 

dl 

andl 

#0xf,  dl 

1 

mask  out  all  but 

low  byte 

bne 

dvlopl 

1 

non-zero  so  skip 

lead  zero  test 

#  Quotient  is  zero.  Check  lead 
if  zero  should  be 

zero 

flag 

(d3  =  0)  to  see 

#  suppressed  by 

substituting  a  space. 

andb 

d3,  d3 

1 

set  zero  flag  if 

d3  still  =  0 

jne 

dvlopl 

1 

zero  suppress  off 

-  go  print  zero 

movb 

#aspace,  dl 

1 

use  space  to 

suppress  leading  zeros 

bra 

dvlop2 

1 

go  print  space 

#  Store  the  ascii  value  in  line 

assy 

area 

pointed  to  by  aO 

dvlopl :  movb 
zero  suppress 

#0xff,  d3 

1 

turn  off  lead 

addb 

#0x30,  dl 

1 

form  an  ascii 

number 
dvlop2 :  movb 

dl,  a0@+ 

1 

store  in  line 

assy  area 
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#  Get  remainder  ready  for  division  by  the  next  power  of  10 


swap  dO 

lower  word 

andl  #0xffff,  dO 
quotient  part 

#  Test  for  end  of  divide  loop 

subb  #1,  d2 

count 

jne  dvloop 

#  End  of  loop.  Last  remainder 
ascii  and  store 

#  in  line  assy  area. 

addb  #azero,  dO 

movb  dO,  a0@ 

rts 

#  Handle  over range  condition 


I  move  remainder  to 
I  mask  out  old 

I  decrement  loop 
I  loop  if  not  done 
is  last  digit.  Convert  to 

1  form  ascii  digit 

I  return 


ovrrng : 

movl 

#5,  d2 

1  used  d2  as  loop 

counter 

movl 

#ormsg/ 

al 

1  get  address  of 

message 

orrnl : 

movb 

al@+,  a0@+ 

1  move  bytes 

subb 

#1,  d2 

1  decrement  count 

bne 

orrnl 

1  loop  till  copy 

conplete 

rts 

#  Powers  of  ten 

used  to 

convert 

from  hex  to  ascii 

.even 

divsr : 

.long 

1000 

1  divide  by  1000 

.long 

100 

1  then  by  100 

.  long 

10 

1  then  by  10 
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#  Overrange  message 
ormsg;  .ascii  “OVER" 

#  Assemble  and  print  data  to  console.  The  nomval,  Q,  and 
hits  values  are 

#  written  to  the  data  message  assembly  string,  and  then  the 
string  is 

#  printed  to  the  console. 


prdata :  movl 

in  assembly  area 

#rdta,  aO 

1  get 

data  address 

movl 

nomval ,  dO 

1  get 

range  value 

jsr 

hexasc 

1  decimal 

value  to  assembly 

area 

movl 

#qdta,  aO 

1  get 

qval  address 

in  assembly  area 

movl 

qval ,  dO 

1  get 

Q  value 

jsr 

hexasc 

1  decimal 

value  to  assembly 

area 

movl 

#hdta,  aO 

1  get 

hit  value 

address  in  assembly  area 

movl 

hitval,  dO 

1  get 

hit  value 

jsr 

hexasc 

1  decimal 

value  to  assembly 

area 

movl 

#dtamsg,  aO 

1  get  start 

address  of  data  message 

movl  tdtmse,  al 

1  get 

end  address 

of  message  +  1 

jsr 

prline 

1  print 

to  console 

rts 

#  Print  Line  to  console.  Call  with  address  of  first 
character  in  aO 

#  register,  and  the  address  of  the  last  character  +  1  in 
the  al  register. 

#  The  routine  adds  a  <CR><LF>  at  the  end  of  the  line, 

prline:  .word  0x48e7  I  moveml  aO-al,  - 
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(sp)  instruction 

.word  OxOOcO  I  mask  for  al-al 

trap  #15  I  invoke  monitor 

function 

.word  0x0022  1  .out In  function 

rts 

#  Print  string  to  console.  Call  with  address  of  first 
character  in  aO 

#  register,  and  the  address  of  the  last  character  +  1  in 
the  al  register. 

#  The  routine  does  not  add  a  <CR><LF>  at  the  end  of  the 
string. 


prstng:  .word 

0x48e7 

1  moveml  aO-al,  - 

(sp)  instruction 

.word 

OxOOcO 

1  mask  for  al-al 

trap 

fiinction 

#15 

1  invoke  monitor 

.word 

rts 

0x0021 

1  .outstr  function 

#  Read  line  from  console.  Console  input  is  placed  in  a 
buffer  until  a 

#  <cr>  is  typed.  The  address  of  the  count  byte  is  returned 
in  aO .  The 

#  string  consists  of  the  count  byte  followed  by  that  many 
characters . 

#  The  <cr>  (or  <cr><lf>)  are  not  included  in  the  count  of 
characters . 


rdline:  pea 

sdata : 1 

1  use 

data  buffer  for 

string 

trap 

monitor  function 

#15 

1  invoke 

.word 

function 

0x0004 

1  . readln 

movl 

in  aO 

rts 

#sdata,  aO 

1  put  buffer  start 

#  Sonar  parameter  table.  Each  sonar  has:  (1)  the  address 
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of  its  data 

#  register,  (2)  two  ascii  characters  encoding  its  number, 
and  (3)  its 

#  group  enable  code  to  write  to  the  sonar  command  register. 

.even 


sptabl :  . long 

0xffff83f0 

1  sonar  0 

register 

.ascii 

*  0  * 

ascii  code 

.word 

0x0100 

group  comand  byte 

.long 

0xffff83f4 

1  sonar  1 

.ascii 

M  ^  N 

.word 

0x0200 

.  long 

0xffff83f4 

1  sonar  2 

.ascii 

“  2  “ 

.word 

0x0100 

.  long 

0xffff83f0 

1  sonar  3 

.ascii 

M  ^  If 

.word 

0x0200 

.  long 

0xffff83f2 

1  sonar  4 

.ascii 

II  4 « 

.word 

0x0200 

.long 

0xffff83f2 

1  sonar  5 

.ascii 

H  2  H 

.word 

0x0100 

.  long 

0xffff83f6 

1  sonar  6 

.ascii 

II  g« 

.word 

0x0200 

.  long 

0xffff83f6 

1  sonar  7 

.ascii 

M  n 

.word 

0x0100 

.  long 

0xffff83f4 

1  sonar  8 

.ascii 

1.  8« 

.word 

0x0400 

.  long 

0xffff83f6 

1  sonar  9 

.ascii 

II  g  II 

.word 

0x0400 

.long 

0xffff83f0 

1  sonar  10 

ascii 

"10" 

.word 

0x0400 

.  long 

0xffff83f2 

1  sonar  11 
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.ascii 

•11" 

.word 

0x0400 

.  long 

0xffff83f0 

.ascii 

•MN" 

.word 

0x0800 

.  long 

0xffff83f2 

.ascii 

•IK" 

.word 

0x0800 

.  long 

0xffff83f4 

.ascii 

“2K" 

.word 

0x0800 

.  long 

0xffff83f6 

.ascii 

“OV" 

.word 

0x0800 

stmesg:  .ascii “Press  number  of  sonar 

exit" 

stmese : 

husmsg : 

.ascii 

•HUSH  MODE  ON! " 

husmse ; 

gapmsg : 

.ascii 

• DELAY [mS] =?" 

gapmse : 

derrms : 

.ascii 

"BAD  DELAY  VALUE! 

derrme ; 

.even 

#  Data  message  assembly  area. 

dtamsg: 

.ascii 

"  0  =  " 

rdta ; 

.ascii 

U  N 

.ascii 

",  Q  =" 

gdi 

.ascii 

II  H 

.ascii 

",  H  =" 

hdta  : 

.ascii 

H  U 

dtmse: 

.even 

gapval : 

.  long 

0 

delay  gap 

value 

gapsiz : 

.  long 

0 

computed  delay  gap 

count 

hushf : 

.long 

0 

mode  flag 

saddr : 

.  long 

0 

I  min  range  test 

I  IK  test 

I  2K  test 

I  over  test 

test .  Press  Q  to 


I  current 

I 

I  hush 
1  sdata 
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0 


I  ping 


array  pointer 
pingct :  . long 

down  counter 

sdreg:  .long  0  I  data 

reg  addr  for  current  sonar 

nomval :  . long  0  I  nominal 

value  storage 

qval:  .long  0  I  quality 

value  storage 

hitval:  .long  0  I  hit 

rate  storage 

sdata:  .skip  sanples  *  2  I  data  value 

storage  table 

endval:  .long  Oxaa  1  end  of 

program  mark 
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APPENDIX  B.  USER  FILE 


1.  Simple  Straight  Running  #1 

/*  Simple  Straight  Running  #1  */ 
/*Masakuni  Michiue  June  3, 1994  */ 
#include  “minl.h” 

UserQ 

{ 

CONFIGURATION  pi; 
int  dummy; 

def_configuration(0.0, 0.0, 0.0, 0.0,  &pl); 

speed(lO.O); 

set_rob(&pl); 

line(&pl); 

dummy  =  GetlntQ; 

stopOO; 


56 


LIST  OF  REFERENCES 


1.  Kanayama,  Y.,  “Mathematical  Theory  of  Robotics:  Introduction  to  2D  Spatial 
Reasoning,”  Lecmre  Notes  of  the  Advanced  Robotics  Course,  Department  of 
Computer  Science,  Naval  Postgraduate  School,  Winter  Quarter  1994. 

2.  Byrne,  G.  Patric.,  A  Mobile  Robot  Sonar  System  With  Obstacle  Avoidance,  Master’s 
Thesis,  Naval  Postgraduate  School,  Monterey,  California,  March,  1994. 

3..  Paul  Horowitz,  Winfield  Hill.,  The  Art  Of  Electronics-2 nd  ed..  New  York: 
Cambridge,  1991 

4.  Marvin  J.  Rsher.,  Power  Electronics,  Boston:  PWS-KENT,  1991 

5.  Technical  Report  for  LinCMOS  Operational  Amplifier  TLC27x  series,  TI 
Semiconductor  Corp.,  Japan,  Tec.  Info.No.  74, 1987 

6.  Data  Sheet  of  Ultrasonic  Transducer  TIR40-16,  Japan  Ceramic  Corp.,  Japan,  1992 


57 


INITUL  DISTRIBUTION  LIST 


Defense  Technical  Information  Center  2 

Cameron  Station 
Alexandria,  VA  22304-6145 

Dudley  Knox  Library,  Code  52  2 

Naval  Postgraduate  School 
Monterey,  CA  93943-5101 

Chairman,  Code  EC  2 

Electrical  &Computer  Engineering  Department 
Naval  Postgraduate  School 
Monterey,  CA  93943-5121 

Dr.  Yutaka  Kanayama,  Code  CS/Ka  2 

Computer  Science  Department 
Naval  Postgraduate  School 
Monterey,  CA  93943-5 118 

Dr.  E>avid  Jenn,  Code  EC/Jn  2 

Electrical  &  Computer  Engineering  Department 
Naval  Postgraduate  School 
Monterey,  CA  93943-5121 

LCDR  Masakuni  Michiue  1 

1st  Technical  Division,  Technical  Eiepartment 
Maritime  Staff  Office,  Japanese  Defense  Agency 
9-7-45  Akasaka  Minato-Ku  Tokyo,  Japan 


58 


